TITLE OF THE INVENTION 

APPARATUS, METHOD OR SYSTEM FOR CONTROLLING MOBILE BODY 

BACKGROUND OF THE INVENTION 
[0001] 

The present invention relates to an apparatus and a method 
of controlling a mobile body, and a mobile body system. 
[0002] 

A synchronous motor that uses a permanent magnet to create 
a magnetic field has recently been applied to various mechanical 
apparatuses for the purpose of reducing the size of the 
apparatuses and increasing efficiency. 

[0003] 

However, in order to control rotation of a synchronous 
motor, it is necessary to recognize the position of a rotor, 
i.e. a magnetic pole position, and to control power supply. 
To do so, means for detecting a magnetic pole position is required. 
For example, the prior art disclosed in Japanese Application 
Patent Laid-Open Publication No. Hei 10-80188 requires a 
magnetic pole position sensor. This kind of magnetic pole 
position detector requires effort to align a motor shaft with 
an encoder shaft or complicated, painstaking maintenance. 

[0004] 

To eliminate such pj.oLleuis, there havG been scs?.s studies 
of technology to control a magnetic pole position of a 
synchronous motor without using a sensor, as described in 
Proceedings of the 2 000 Japan Industry Applications Society 
Conference "No. 97: A New Position Sensor-less Control of 



Permanent Magnet Synchronous Motor using Direct Position Error 
Estimation^ Pages 963-966. 
[0005] 

Figure 10 illustrates an example of a permanent magnet-type 
synchronous motor control system in accordance with the 
magnetic pole position sensor-less control technology. This 
control system comprises a first coordinate transformer 3a 
which obtains detected current values Id and Iq of a rotating 
coordinate system by inputting motor phase detected current 
values lu and Iw detected by a current detector, an axis error 
estimator 3b which obtains an error AG between a magnetic pole 
position em of a motor rotor and an estimated magnetic pole 
position value emc by inputting the detected current values 
Id and Iq, a motor speed computing element 3c which obtains 
estimated motor speed com by inputting the error AG, a rotor 
position estimator 3d which obtains an estimated magnetic pole 
position value emc by inputting the estimated motor speed com, 
a current command computing element 3e which obtains current 
command values Id* and Iq* by inputting the estimated motor 
speed com and a motor speed command value oim*, an output voltage 
command computing element 3f which obtains output voltage 
commands Vd* and Vq* by inputting the current command values 
Id* and Iq* / and a second coordinate transformer 3g which obtains 
drive unit drive cc"jr.andG Vu*, Vv* and Vv/* for driving the 
motor by inputting the output voltage commands Vd* and Vq* . 
This example uses an estimated value emc obtained by a rotor 
position estimator 3d as a magnetic pole position Gm so that 
a permanent magnet-type synchronous motor can be driven without 
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requiring a magnetic pole position sensor. 
[0006] 

Technology mentioned above has made it possible to rotate 
a synchronous motor without requiring a detector which detects 
5 a magnetic pole position of the rotor. 
[0007] 

For example^ in Japanese Application Patent Laid-Gpen 
Publication No. 2000-78878, an example of an actual mobile 
body system is shown that applies the sensor-less control 
10 technology for controlling a magnetic pole position of a 

synchronous motor. However, this example requires an encoder 
as a mobile body position detector so that the mobile body 
system itself can be controlled to stop at a fixed point. 

15 SUMMARY OF THE INVENTION 

[0008] 

Problems still remain when a mobile body position detector 
is required: difficulties in mounting the detector, unnecessary 
occupation of space, and adverse effects on the system's 
20 reliability. 

[0009] 

The main purpose of the present invention is to control 
the position of a mobile body without using a position detector 
as to a mobile body syste^i that uces a synchronous motor as 
25 a driving power source. 
[0010] 

The above problems can be solved by estimating a magnetic 
pole position of a rotor of a synchronous motor based on 



elect:rical quantities in relation to electric power supplied 
to the synchronous motor and further by estimating the mobile 
body position on the basis of the estimated magnetic pole 
pos it ion . Here , electrical quantities in relation to electric 
power supplied to a synchronous motor are currents or voltages 
that are supplied to the synchronous motor. 
[0011] 

This means makes it possible to control the position of 
a mobile body without using a mobile body position detector 
because the position of a mobile body is estimated based on 
a magnetic pole position of the rotor of the synchronous motor 
according to electrical quantities. Further, this means 
preferably makes it possible to highly accurately control the 
position by correcting an estimated position of the mobile 
body based on absolute position information of the mobile body. 

[0012] 

A mobile body can be any of an elevator car, elevator counter 
weight, elevator door, escalator step, rolling stock, and so 
on. A synchronous motor can be any of a permanent magnet-type 
synchronous motor, wire-wound synchronous motor, synchronous 
reluctance motor, and so on. 



BRIEF DESCRIPTION OF THE DRAWINGS 

Figure 1 is a mcbils body systsni v;hich is a first embodiment 
of the present invention. 

Figure 2 is a mobile body system which is a second embodiment 
of the present invention. 

Figure 3 is a mobile body system which is a third embodiment 



of the present invention. 

Figure 4 is a mobile body system which is a fourth embodiment 
of the present invention. 

Figure 5 is a mobile body system which is a fifth embodiment 
of the present invention. 

Figure 6 is a mobile body system which is a sixth embodiment 
of the present invention. 

Figure 7 is a mobile body system which is a seventh 
embodiment of the present invention. 

Figure 8 is a mobile body system which is an eighth 
embodiment of the present invention. 

Figure 9 is a mobile body system which is a ninth embodiment 
of the present invention. 

Figure 10 is an example that shows a configuration of a 
synchronous motor drive control system. 

DETAILED DESCRIPTION OF THE INVENTION 
[0013] 

Figure 1 illustrates a mobile body system which is a first 
embodiment of the present invention. In Figure 1^ there are 
shown a synchronous motor 1 which generates torque to drive 
a mobile body 4, a drive unit 2 which supplies electric power 
to the synchronous motor 1, a controller 3 which controls the 
drive unit 2 , the mublle body 4 , and mcbile body driving means 
5 which is mechanically connected to the synchronous motor 
1 and drives the mobile body 4 by using the torque generated 
by the synchronous motor 1 . Further, the drive unit 2 comprises 
a DC power source 201, a power converter 202 which converts 



DC power from the DC power source 201 to AC power, and a current 
detector 203 which detects current supplied to the synchronous 
motor 1 . The controller 3 comprises a rotor position estimator 
301 which estimates a magnetic pole position of a rotor of 
a synchronous motor from the current detected by the current 
detector 2 03 , and a drive command generator 302 which generates 
drive commands given to the drive unit 2 based on a magnetic 
pole position 0mc estimated by the rotor position estimator 
301 so that the speed of the synchronous motor 1 will approach 
a speed command torn*. Furthermore, there are shown a mobile 
body position estimator 6 which estimates the position of the 
mobile body 4 from a magnetic pole position emc estimated by 
the rotor position estimator 301, position information 
correcting means 7 which imports absolute position information 
of the mobile body 4 thereby correcting mobile body position 
information stored in the mobile body position estimator 6, 
and a motor speed command generator 8 which creates a speed 
command om* and sends it to the drive command generator 302 
so that the estimated mobile body position Xc that is obtained 
by the mobile body position estimator 6 will approach a position 
command X* of the mobile body 4 . There is also shown a position 
indicator 9 which creates position information of the mobile 
body 4 based on the estimated mobile body position Xc and displays 
the information. 
[0014] 

Next, operations of a mobile body system which is a first 
embodiment of the present invention will be described . A power 
converter 2 02 converts DC power supplied from a DC power source 



201 to AC power according to drive commands generated by a 
drive command generator 302 and outputs the AC power to rotate 
a synchronous motor 1 . A mobile body 4 uses the synchronous 
motor 1 as a power source via drive means 5 to change its posit ion • 
Further, a rotor position estimator 301 estimates a position 
em of a rotor of the synchronous motor 1 by using an output 
of a current detector 2 03 and outputs the estimated quantity 
emc. Here, a variety of configurations of a controller 3 can 
be expected including a position estimation method by a rotor 
position estimator 301 • For example, an embodiment shown in 
Figure 10 is one of those configurations. 
[0015] 

Now, a mobile body position estimator 6 will be described. 
A relationship between a rotor position em of a synchronous 
motor 1 and a position X of a mobile body 4 will be explained. 
Here, if the mobile body drive means 5 is a driving wheel and 
the distance the mobile body 4 travels when the driving wheel 
makes one revolution is L , the distance the mobile body 4 travels 
when the rotor of the synchronous motor 1 makes one revolution 
is also L. This indicates that there is a relationship between 
X and em as shown in the following equation. 

[0016] 

[0017] 

Here, XO indicates the initial position of the mobile body . 
The relationship expressed by the following equation usually 



holds . 

[0018] 

em = emc (2) 
Accordingly, the position X of the mobile body 4 can be 
estimated by using the estimated position emc output by a rotor 
position estimator 301, and the relationships expressed by 
Equations (1) and (2). Specifically, in a mobile body position 
estimator 6 , an estimated position Xc can be obtained by Equation 
(3) in which a position X is replaced with an estimated mobile 
body position Xc instead of Equation (1). 
[0019] 

xc==xo+/, ( aeocdeg.] dl (3) 

[0020] 

As described above, this embodiment can obtain position 
information of a mobile body driven by a synchronous motor 
without employing a dedicated mobile body position detector. 
Further, the magnetic pole position of the rotor of the 
synchronous motor corresponds to the distance a mobile body 
travels. Therefore, the position of a mobile body can 
relatively easily and accurately be estimated from the 
estimated value of the magnetic pole position. 
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Next, position information correcting means 7 will be 
described. As described above, a mobile body position 
estimator 6 estimates the position of a mobile body 4 , however, 
an error occurs between the actual mobile body position X and 
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the estimated mobile body position Xc because the relationship 
expressed by Equation (1) is destroyed due to drive means 5 
slipping or worn out. At this point, position information 
correcting means 7 imports absolute position information of 
a mobile body 4 and outputs information to correct mobile body 
position information stored in a mobile body position estimator 
6 . Absolute position information is input into the mobile body 
position estimator 6 by the position information correcting 
means 7. The mobile body position estimator 6 uses the newly 
entered absolute position information as an estimated mobile 
body position Xc. This makes it possible to correct an 
estimated position and set a correct position even though an 
error occurs between an actual position of a mobile body 4 
and an estimated position obtained by a mobile body position 
estimator 6. Thus, a mobile body position can be accurately 
estimated by using position information correcting means 7. 



Further, a motor speed command generator 8 inputs a mobile 
body position command X* and an estimated mobile body position 
Xc to generate a speed command om* given to a synchronous motor 
1 so that the estimated mobile body position Xc will approach 
the target position X*. If the motor speed command generator 
8 can reduce the motor speed command to 0 (zero) at a 



position of the mobile body 4 . Thus , such a motor speed command 
generator 8 makes it possible to control the position of a 
mobile body without using a mobile body position detector. 





[0023] 



Furthermore, a mobile body position indicator 9 inputs 
an estimated mobile body position Xc to create position 
information of a mobile body 4 and indicates the information. 
Such a mobile body position indicator 9 makes it possible to 
indicate a position of a mobile body without using a mobile 
body position detector. 

[0024] 

It is also possible to reduce the size of a mobile body 
system and save energy by using a permanent magnet-type 
synchronous motor as a synchronous motor 1 . 

[0025] 

A power source which has rectified an alternate current 
by a rectifier circuit or a battery can be used as a DC power 
source 201. Further, the estimated rotor position quantity 
0mc can be calculated not only based on the output current from 
the power converter 202, but also based on output voltage, 
input DC current, or DC voltage. In this case, a detector for 
detecting those electrical quantities is mounted instead of 
a current detector 2 03 and a calculation method executed by 
a controller 3 including a rotor position estimator 301 is 
changed. Furthermore, in an embodiment shown in Figure 1, 
mobile body position information stored in a mobile body 
position estimator is corrected according to absolute position 
inforuiaLion of a mobile body by using position information 
correcting means . This can be applied to cases where the mobile 
body position is estimated from not only an estimated rotor 
position, but also from a detected value of the rotor position, 
or a detected or estimated value of the number of revolutions 



of the rotor. 
[0026] 

Figure 2 illustrates a mobile body system which is a second 
embodiment of the present invention. In this embodiment, an 
elevator car 401 and a counter weight 4 02 are mobile bodies 
and a sheave 501 is drive means 5. The elevator car 401 and 
the counter weight 402 are driven by a synchronous motor 1 
via the sheave 501. Operations of other elements are the same 
as those that are explained in a first embodiment. This 
embodiment can detect and control the position of the elevator 
car 401 or the counter weight 402 without using a magnetic 
pole position detector of a synchronous motor 1 or a position 
detector for the elevator car 401 or the counter weight 4 02. 

[0027] 

When a motor is installed in the bottom or top of an elevator 
shaft as shown in the embodiment of Figure 2 and if a magnetic 
pole position detector is required, it becomes difficult to 
replace, mount, or adjust the magnetic pole position detector. 
This embodiment eliminates such a problem. 

[0028] 

Figure 3 illustrates a mobile body system which is a third 
embodiment of the present invention. In this embodiment, an 
elevator door 4 03 is a mobile body and a door drive unit 502 
is drive means 5. The elevacor uoor 403 is driven by a 
synchronous motor 1 via the door drive unit 502. Operations 
of other elements are the same as those that are explained 
in a first embodiment. When the installation space is very 
small and limited, this embodiment increases equipment layout 



space and saves installation space. 
[0029] 

If the embodiment shown in Figure 3 is applied to another 
door which is driven by a synchronous motor but is not an elevator 
door^ the same effect can be expected. 

[0030] 

Figure 4 illustrates a mobile body system which is a fourth 
embodiment of the present invention. In this embodiment, a 
mobile body system is applied to a wheel chair compatible 
escalator wherein wheel chair compatible steps 4 04 are mobile 
bodies and step drive means 503 is drive means 5. Escalator 
steps including wheel chair compatible steps 4 04 are driven 
by a synchronous motor 1 via the step drive means 503. 
Operations of other elements are the same as those that are 
explained in a first embodiment. 

[0031] 

The wheel chair compatible escalator has a function that 
horizontally aligns at least two or three wheel chair compatible 
steps 404, among steps connected in a ring as shown in Figure 
4, at one location so that a wheel chair can be placed on those 
steps. For example, when a wheel chair request button is 
pressed, a controller of the wheel chair compatible escalator, 
i.e. a mobile body system, estimates the position of the wheel 
chair compacible steps 404 by using a "tObilc body position 
estimator 6 and stops the steps at the entrance of the escalator. 
This embodiment can detect the position of the steps without 
using a position detector which protrudes in the direction 
parallel to the steps . Consequently , it is possible to decrease 



a width of the escalator thereby making the best use of space 
in a building where the escalator is installed. 
[0032] 

Figure 5 illustrates a mobile body system which is a fifth 
embodiment of the present invention. In this embodiment^ 
rolling stock 4 05 is a mobile body and driving wheels 504 are 
drive means . Operations of other elements are the same as those 
that are explained in a first embodiment. A commonly-used 
conventional signal system can distinguish the presence of 
a train located in a given block section^ however, it cannot 
detect the position of the train or the number of trains in 
the same block section. On the other hand, this embodiment 
can obtain position information of each train. Thus, it is 
possible to obtain position information of a plurality of trains 
which exist in a block section without employing an especially 
accurate position detector. As a result, high traffic density 
train running schedule becomes feasible. 

[0033] 

Figure 6 illustrates a mobile body system which is a sixth 
embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises a fixed point 
701 disposed in the traveling area of a mobile body 4 , absolute 
position information providing means 7 02 which provides 
position inf oruiciLlori obtained when ths nicbilc body 4 passes 
by the fixed point 701 as absolute position information, and 
information providing means 7 03 which inputs the absolute 
position information and outputs position information to 
correct absolute position information stored in a mobile body 



position estimator 6. 
[0034] 

In the embodiment shown in Figure 6, if an error occurs 
in the position of the mobile body 4 estimated by the mobile 
body position estimator 6, the estimated position will be 
corrected by the following procedures. A plurality of fixed 
points 7 01 comprising metal shielding plates and the like are 
installed at specified positions, for example, in front of 
and at the back of the mobile body stop position. Absolute 
position information providing means 702 comprising of a 
positector or the like is placed on the mobile body side. The 
absolute position information providing means 702 accepts 
interrupt when it is opposed to the fixed point 701, reads 
out absolute position information which has been made into 
a table and overwrites position information stored in the mobile 
body position estimator 6. This makes it possible to 
consistently and accurately estimate the position of a mobile 
body when the mobile body passes by a specified position. This 
embodiment compensates for errors caused by slippery or 
worn-out drive means 5. As a consequence, position estimation 
by a mobile body position estimator 6 becomes highly reliable 
and accurate. 

[0035] 

Figure 7 illus 'crates aiuobila body systemv.'hich is a seventh 
embodiment of the present invention. In this embodiment, 
correcting operation switching means 704 is added to the 
embodiment shown in Figure 6. When a mobile body position 
estimator 6 estimates that a mobile body 4 exists in the mobile 



body existence detecting area which is a vicinity of a fixed 
point 7 01, the correcting operation switching means 7 04 accepts 
interrupt by absolute position information providing means 
702 which is opposed to the fixed point 7 01 and enables position 
information correcting operation via correction information 
providing means 703. This allows the absolute position 
information providing means 7 02 to operate only in the vicinity 
of the area where correcting operation is originally conducted . 
Accordingly, it is possible to reduce malfunction due to noise. 
[0036] 

Furthermore, in order to increase the accuracy of stopping 
a mobile body at a predetermined position, it is recommended 
that a fixed point 701, shown in Figure 6 and Figure 7, be 
installed at a position in front of each floor when a mobile 
body is an elevator car, at the fully opened or fully closed 
end when a mobile body is an elevator door, and at an entrance 
or an exit of an escalator when a mobile body system is a wheel 
chair compatible escalator. 

[00371 

Figure 8 illustrates a mobile body system which is an eighth 
embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises a fixed point 
701, absolute position information providing means 702, 
correction information providing meanss 703 which outputs 
corrective position information so that a mobile body position 
estimator 6 can correct an estimated position, and initial 
position setting means 705 which outputs corrective position 
information at the initial state. 



[0038] 

Next^ an initial position setting operation by the 
embodiment shown in Figure 8 will be described. The value XO 
in Equation (1) is initially set when a system is activated 
by turning on the power. Specifically, after the power is 
turned on, a mobile body slowly travels to an end of the traveling 
range. After the initial absolute position information is 
obtained, the value XO stored in a mobile body position estimator 
6 is initialized by initial position setting means 705. After 
that, in order to measure the position of a fixed point, a 
revolution is made at a speed that does not race the drive 
means. When position information which corresponds to the 
absolute position of each fixed point is obtained, settings 
of initial position information is completed. For example, 
when a mobile body is an elevator car or a counter weight, 
an initial position setting operation starts either at the 
top or bottom of an elevator shaft . When a mobile body is rolling 
stock, an initial position setting operation starts when a 
fixed point placed at an originating station is opposed to 
absolute position information providing means 702. This 
embodiment does not require designing and setting the absolute 
position of a plurality of fixed points beforehand and easily 
establishes a position information correcting system. 

[0039] 

Figure 9 illustrates a mobile body system which is a ninth 
embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises absolute 
position information providing means 702, correction 
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information providing means 703^ correcting operation 
switching means 704, and a satellite 706. 
[0040] 

Operations of the embodiment shown in Figure 9 will be 
described in the following. Absolute position information 
providing means 702 obtains absolute position information from 
a satellite 7 06 and outputs the information. When a mobile 
body position estimator 6 estimates that a mobile body 4 has 
reached a predetermined point in the traveling area, correcting 
operation switching means 704 accepts absolute position 
information which is output by the absolute position 
information providing means 702 and enables position 
information correcting operation via correction information 
providing means 703. This embodiment can correct shifts of 
an estimated position obtained by the mobile body position 
estimator 6 without placing a fixed point in the mobile body 
traveling area. Further, a wireless station installed on the 
ground can be used instead of a satellite as means by which 
the absolute position information providing means obtains 
absolute position information. 

[0041] 

Moreover, as shown in any one of embodiments described 
above, a method of correcting a mobile body position estimated 
by a mobile body position esrimator based on absolute position 
information of a mobile body or setting the initial value of 
a mobile body position can be applied to cases where a mobile 
body position is estimated not only from an estimated rotor 
position, but also from a detected value of a rotor position. 
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or a detected or estimated value of the number of revolutions 
of the rotor. 
[0042] 

The present invention can detect a position of a mobile 
body without using a mobile body position detector. Further, 
correcting an estimated position of a mobile body by using 
absolute position information increases the accuracy and 
reliability of mobile body position estimation. 



